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1 . Abstract 

t his pape r , the problem of position and force control 
compliant motion of the manipulators 1s considered. The external force and 
the position of the end-effector are related by a second order impedance 
function. The force control problem Is then translated Into a position 
control problem. For that, an adaptive controller Is de. gned to achieve 
the compliant motion. The design uses the Liapunov's direct method to 
derive the adaptation law. The stability of the process Is guaranteed from 
the Liapunov's stability theory. The controller does not require the 
knowledge of the system parameters for the Implementation, and hence Is easy 
for apr at ions. 

2. Introduction 
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While position control is appropriate when a manipulator Is following a trajectory through 
space, when any contact Is made between the end-effector and the manipulator’s environment, 
position control may not suffice. Precise control of manipulators, In the face of uncertainties 
and variations In their environments, is a prerequisite to feasible application of robot 
manipulators to complex handling and assembly problems, In industry and space* An important 
step toward achieving such control may be taken by providing manipulator hands with sensors that 
provide Information about the progress of interactions with the environment. Properly applied 
force control can reduce the positioning accuracy necessary to perform a given task accurately, 
and in fact make possible assembly tasks which would be otherwise impossible. 

The problem of posit Ion/ force control has attracted many researchers In the recont past 
years [1-5]. Among these works one can distinguish two different approaches. The first 
approach Is aimed at providing the user with a means of specifying and controlling forces and 
positions In a non-conf 1 1 ct 1 ng way, [1-3]. This Involves specification of a set of position 
controlled axes and an orthogonal set of force controlled axes. The second aporoach is aimed at 
developing a relationship between Interaction forces and manipulator positions, [4,53. This 
way, by controlling the manipulator position and specifying Its relationship to the Interaction 
forces, a designer can ensure that the manipulator will be able to maneuver In a constrained 
environment while maintaining appropriate contact forces. 

In the first group, Paul and Shimano [1] partition the cartesian space and find the best 
Joints to force servo to approximate the desired force and position commands. Ralbert and Craig 
[2] involve alt Joints in satisfying the cartesian position and force commands simultaneously. 
Whitney [31 arrives at a single loop velocity control scheme with the net effect of controlling 
the contact force. In that paper, the Impedance matrix approach establishes a connection 
between the two different approaches mentioned above. In all the above works, the structure of 
the controller depends on the kinematics and dynamics of the manipulator and of the environment. 
That Is, If the end-effector of a manipulator in motion encounters a point with new constraint, 
then the controller structure must be changed. In the second group, Salisbury [4] defines a 
linear static function that relates Interaction forces to end-effector position, by a stiffness 
matrix In a cartesian coordinate frame. Monitoring this relationship ensures that the 
manipulator will be able to maneuver successfully in a constrained environment. Kazerooni, et. 
al. [5] extend the previous work [4] and define a generalized mechanical impedance for the 
manipulator which 1s used for the compliant motion control. Their approach is an extended 
frequency icmain approach of Salisbury's stiffness control. Also, their design is stable and 
sho.'s robustness In the face of bounded uncertainties. In the second group approach, the 
co’itrol ler ' s structure does not depend on the kinematics and dynamics of the manipulator and 
that of the environment. However, In both groups, the controller requires the knowledge of the 
parameters of the system. 

In this work, the concept of mechanical Impedance, [4,5] is used in order to relate the 
external forces to the position and orientation of the end-effector. Hence, the problem of 
force control Is recasted in the position control problem. The objective Is to design a 
controller for the manipulator, so that the perturbed dynamic relationship for the overall 
system is given by a second order impedance function. For tha*- , a model reference adaptive 
controller is deslgred [6,7], where the desired impedance function is used to select the 
adaptive control model. The direct method of Liapunov Is used for the derivation of adaptation 
laws. This guarantees the stability of the overall system, 
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Consider a manipulator with n Joints, providing n degrees of freedom, 
of suoh manipulator la given by 


The dynamic equation 


M(q) q ♦ h(q,q) ♦ g(q) • T 


where q is the n-dimenalonal veotor of Joint angular posit Iona, q and q are, respectively , the 
vectors of Joint angular velocities and Joint angular accelerations, M(q) is the nxn symmetric, 

positive definite Inertia matrix or the manipulator, h(q,q) Is the n-dlmenslonal vector of 
Coriolis and centrifugal forces, g(q) is the n-dlmenslonal vector of gravitational forces, and T 
Is the n-dlmenslonal veotor of torque Inputs, applied to the manipulator. 

Let Aq be the perturbation of the Joint angular position vector q, from q # , and AT be the 
perturbation of the Input torques, from T t . Then the linearized dynamic equation la given by 

M(q a ) Aq • G(q a ) - AT (2) 

where, G(q # ) • [3g/3q,. . .3g/3q n ] for q - q«. 

The Joint input torques applied to the manipulator, the external forces on the end- 
effeotor, and the actuator torques are related by 

AT - LAT ♦ JV (3) 

a c 

where AT, AT and AF are n-dlmensional perturbations of the Joint input torques, the actuator 
torques and® the end-effector external forces, and is the Jacobian matrix which transform 
Joint angle coordinates to end-effector position and orientation. Also, ,the dynamic equation 
of actuators are approximately given by 


AT 

a 


A AT 


a a 


• v u 


where 


(4) 


A 


a 


B a 


diag [-1^ * ♦ • • 
diag [b, b n ] 


and AU is the n-dlmensional vector of actuator inputs, [5]. 


From equations (2), (3,) and (4), the dynamic equation of the manipulator and the actuator is 
given by 


AX - A AX ♦ B AU ♦ 0 AF (5)* 

Aq - C AX 

where 


r, T .* T iT «3n 
AX - [Aq , Aq ,AT a 3 e R 



C - [I 0 0]. 

and the pairs C A , B ) and (A,C) are respectively controllable and observable. 
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Modal lUfarenoe Adapt lv Control 


In this section, a eontrollsr la daalgnad ao that th# dynamic perturbation aquation of tha 
overall aloaed-loop manipulator system la given according to tha Inverse of the deeired 
lepedanoe. To achieve thla* a Model referenoe adaptive control strategy la employed. The 
reference model la choaen auoh that ita tranafer matrix la identical to the lnverae of the 
dealred mechanical lapedanoe. Henoe, the dynaalo equation of the reference model la given by 


- v x . ♦ V' 

«<J_ * CM 

m mm 


where 

A . 

c » 



( 6 ) 


such that 6X is the 3n-dlmensional incremental vector of model's Joints and actuotors values, 
6F la the n^diaenalonal vector of incremental external forces. The tranafer function matrix of 
the model la given by 

0.(9) • 4q (9>/«P(9) - C [sI-A ]*’b 
mm m in m 

such that the two dominant poles of the model are Riven by 

JC (s) - (Jo 2 • k,s • k ) -t (7) 

cm io 

where J la the Jacobian matrix, and J, k Q , and k, are reapectlvely the inertia matrix, 
stiffness matrix, and damping matrix of the desired mechanical Impedance, given by 

• (Js^ • k,a • k ft ), BY ■ model’ll spatial displacement . 
m i o is 

Let ua define the state error to be 

e • 4X -«X. (8) 

m 

Subtracting aquation (6) from (5), we get the dynamic equation of the 9tate error aa 


a • A e • (A -A)4X ♦ (B -D)«F - B4U. (9) 

mm m 

Let ua now choose the input torque to be 

5U - K x 6X • Kp6F • K e « 00) 

where K , K » K p are variable gain matrices with appropriate dimensions. Plugging <5U from (10) 
Into (9) x , we c gec 


e 


(A -BK )e ♦ ( A -A-BK )6X • (B -D-BK p )«F. 
me m x m r 


(U) 


The problem, now, is how to vary the feedback and the feedforward gain matrics, K %§ Kp and K e , 
such that equation (It) is stable and the state error e approaches zero, according to a 
prespecified transient behavior. 


To achieve perfect model following, the state error and Its derivative should become zero, 
that is e • e • 0. The conditions for perfect model following are given by 



0 

0 

0 


02) 


Furthermore, under perfect model following conditions in (12) the error equation (11) will 
become 


e * A e. (13) 

that is, the transient behavior of the state error is determined by the constant matrix A, which 
is defined by the designer and is Hurwltz. 
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5. Adaptation law 


Th« controller gains or the adaptive system should be adjusted such that the overall 
closed-loop system is stable and follows the reference model. The direct method of Liapunov may 
be chosen for determining the adaptation law, [6,7]* 

Let the corresponding Liapunov function for adaptation be given by 

V- 1 1 • 1 1 p* 1 1 B B "D-BKp 1 1 „♦ 1 1 1 1 s + 1 1 *-* B *BK t 1 1 M ««) 

where P,R, and S are 3n x 3n arbitrary positive definite symmetric oonstant matrices. Also, the 
quadratic norm for any matrix F and any positive definite symmetric oonstant matrix 0 is defined 
by 

||F|| 0 - tr[F T GF3, where tr • trace* 

The function V is positive definite, exoept when there is a perfect model matching it becomes 
zero. Differentiating V, we get 

V - . T (PA*AP). _ _ d (,5) 

♦2tr{(B -D-BK_)‘[P. 4F l ♦ R — <B -D-BK,)] 

" F dt “ F 

♦2tr! (A -A-BK.) T [P. 4X T ♦ S - (A-A-BK )] 

* x dt " X 

♦2tP l ( A-A *BK ) T [P« « T ♦ M - (A -BK -A)]. 

" * dt " 6 

Also notice that, slnoe matrix A is Hurwltz, then for any given posltlvo definite symmetric 
matrix Q there exists a positive definite symmetric matrix P such that 

P A • A T P - -Q 

Now, for the stability, V should be negative. One way to satisfy this is to choose 

* t -1 T 
Kp - B t R Pe4F 

K - bV’p.4X T (16) 

X 

* t -1 T 
- -B t m Pe e 

wnere B^ - [0,0, B \ is the pseudo-inverse of B. However, since R, S and M are arbitrary 
matrices, we can cftoose them such that R8 - ol, SB - 81 and MB • YI, where a,8,Y are positive 
scalars. Then denoting E - [0,0,1], the ldaptatlon a laws can be liven by 

Kp - oEPe6F T 

* T 

K - BEPedX 1 (17) 

x 

K - -YEPee 7 
e 

With these adaptation laws, the 'derivative of the Liapunov function, V, is given by 

V - -Il«llg - -e T 0e<0 

which Is negative for non-zero state error, (i.e. e*0). This guarantees the asymptotic 
stability of the equilibrium point, e - 0. 

The proposed design adaptively controls both the position and the end-effector force, and 
Is appropriate for compliant motion of the robotic manipulators. The proposed adaptive 
controller is shown in Figure 1. 

Moreover, if the spatial displacement and velocity can be directly measured, then the 
knowledge of Is not necessary for the implementation of the adaptive controller. 
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6. Conclusions 


In this paper, ths definition or asohanlosl impedance ussd In [4,5], is •■ployed. The 
sxtsrnsl fores and the position of ths snd-ef factor art rslatsd by a second order impedance 
function. The force control problen Is then translated to a position control problea. An 
adaptive controller la designed for the latter problea to achieve the compliant motion for the 
manipulator. The design uses the Liapunov’s direot aethod to derive the adaptation law. The 
stability of the process Is guaranteed froa the Liapunov’s stability theory. The aajor 
advantage of this aethod la that the controller does not depend on the knowledge of the systee 
paraaeters and those of the envlronaent. It uses the aeasured forces at the end-effector and 
the position and velocity of the end-effecto r in the Joint space. The controller Is s lapis and 
can be easily lapleaented by saall computers. 
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Figure 1 . Adaptive Position/Force Controller for Robot 
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